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Path planning for a movable robot in real life situation has been widely 
cultivated and become research interest for last few decades. Biomimetic 
robots have increased attraction for their capability to develop various kind 
of walking in order to navigate in different environment. To meet this 
requirement of natural insect locomotion has enabled the development of 


composite tiny robots. Almost all insect-scale legged robots take motivation 


from stiff-body hexapods; though, a different distinctive organism we find in 
Keywor ds: nature is centipede, distinguished by its numerous legs and pliable body. This 
Bit oats ; uniqueness is anticipated to present performance benefits to build robot of 
Bioinspired mobile robot : ’ : : ; 

é the said type in terms of swiftness, steadiness, toughness, and adaptation 
Bug algorithm ability. This paper proposes a local path planning algorithm of multiple rake 
Critical point centipede inspired robot namely ModifiedCritical-SnakeBug (MCSB) 


Local path planning algorithm. Algorithm tries to avoid static and dynamic obstacle both. 

Obstacle avoidance The results demonstrate the capability of the algorithm. 
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1. INTRODUCTION 

Creating biologically inspired tiny, responsive itinerant robots has always been great interest in 
research area. Aspiration for robots to travel and control objects flexibly and independently in 3D situation, 
regardless of the presence, absence or direction of any external control system attracts researchers. This 
inspiration is helping to develop various biomimetic robots. One of the reasons to behind this is each kind of 
biological creature has its own outstanding dynamism capability to act and travel through specific type of 
environment, including critical and confined place. Some of the biological inspirations are excellent climbers, 
some wonderful swimmers, and some can fly, some jump very well. The need for robots to be mobile in 
strange and difficult environments is rapidly increasing. This increasing demand brings focus on different 
kind of biologically inspired robots. While discussing about path planning the property of environment or 
the locality where the robot will work is an important issue. If the environment is static then all 
the environmental elements or obstacles are static. In case of dynamic environment the elements may be 
static or may be dynamic. The robot may and may not know all the information about the environment. In 
dynamic environment, path planning comes in two form a) Global path planning — where the information 
about the environment is known to robot before it starts moving and b) Local path planning — where the robot 
doesn’t have any information regarding the environment. This is sensory based path planning where the robot 
uses sensors to get information about the obstacles to avoid it and reach destination. In case of local path 
planning robot acquires information about locality during its movement. In unknown dynamic environment, 
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navigation algorithm of mobile robot avoiding obstacle can be done using future prediction with the help of 
priority behavior [1]. The said process uses single rake robot. But in case of biologically inspired robot like 
snake robot the navigation requires a different kind of locomotion techniques and mechanics [2]. A snake 
robot should be so designed and modeled physically as well mathematically so that it behaves like real snake 
[3]. The motion pattern of snake like robot should be controlled in such way that it will be able to navigate on 
land as well in water [4]. The method to control movement of Snake robot should be well defined [5-7]. This 
kind of robot may use wheels for motion. Other interesting biologically inspired robot is centipede-like milli 
robot [8]. These kinds of robot’s gaits are now one of the most interesting research topics. The navigation and 
obstacle avoiding path planning technique of a mobile robot with multiple rakes using visual or other sensors 
therefore pay attention more and more [9-17]. Apart from snake and centipede other kinds of studied 
biomimetic robots are scorpion [18, 19] and inch worm [20]. 

Bug algorithms are one of the used simple local path planning technique. Critical-PointBug 
algorithm [21] belongs to bug algorithm race that proposes a procedure to reach destination avoiding static 
obstacles. However this algorithm considers a point robot. A development from the said algorithm is 
Critical-SnakeBug algorithm [22]. This algorithm modifies the Critical-PointBug algorithm so that the 
modified version can be used for bio-inspired snake like multiple rake robot. The algorithm exists in [22] is 
useful for static obstacle avoidance during path planning for bio-inspired multiple rake robot where each rake 
is assumed to be a point. But obstacle may not be always static and the rakes of the robot may have some non 
negligible value in its dimension. In those cases the algorithm exists in [22] may not work well. The proposed 
ModifiedCritical-SnakeBug(MCSB) algorithm here is a modification and development of algorithm present 
in [22] for multiple rake centipede inspired robot to avoid static as well as dynamic obstacle. The algorithm 
proposed here considers the rakes of robot to have dimension not as point. Therefore during obstacle 
avoidance it will calculate the safety precaution also and thus the generated path is more realistic. 


2. PROPOSED METHOD 

Imagine a bug is moving to a certain direction and faces with an obstruction in its path. To avoid the 
obstruction the bug circumnavigates it till the motion to the original path is not further blocked. The bug 
algorithms for local path planning and obstacle avoiding are inspired by this behavior of natural bug. These 
are sensor dependent path planning. Two main behaviors of these algorithms are: 1. moving to the objective 
and 2. boundary following of an encountered obstacle. Bug!, Bug2 were the primary algorithms introduced 
by Lumelsky et al [21]. Since then a number of versions have been raised of bug algorithms each with a 
development than the previous one. Mostly used and noted in path planning of mobile robot are TangentBug, 
VisBug, DistBug etc. Except these few other algorithms are Rev, Rev2, OneBug, LeaveBug, PointBug, 
K-Bug, Critical-PointBug, Critica-SnakeBug etc. The main objectives of every bug algorithms attempt to 
shorten the path, shorten the time to reach destination, simplify the algorithm and making it more realistic in 
every condition, shown in Figure 1. 


Tangent Bug 
} Point Bug 
"ss mmm » Critical- 

x PointBug 

> Critical Point 


Figure |. Trajectories formed by different bug algorithm with reference to literature [20] 
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The Critical-SnakeBug algorithm [22] is developed keeping in mind of multi rake robot. This 
algorithm tries to avoid static obstacle of all its links while moving from a source point to destination point. 
Using its body gesture navigating through cluttered and rough surroundings is much easier for snake like 
multi rake robot than other robot. Like other mostly used bug algorithms this algorithm also uses dmin line to 
get the minimum distance from robot to destination. The dmin helps the robot to reach destination by 
traversing minimum distance. The major advantages of Bug algorithms over the other existing path planning 
and obstacle avoiding algorithm is its simplicity and use of minimum number sensors. This proposed 
algorithm uses the technique of one more algorithm namely “OperativeCriticalPoint Bug”, which is yet to be 
published. The algorithm considers dynamic path planning keeping in mind of the dimension of robot. 
Though it is not yet published so not refenced in literature review. 


2.1. Modifiedcritical-snakebug algorithm 

This algorithm assists to locate the path and pass through it for a biologically centipede inspired 
wheeled mobile robot in a plane floor filled with obstacles. The obstacles are unidentified and of standard 
form, dimension, and location. To reach the target from current point it calculates and determines the next 
point to move by getting on the obstacle location. Figure 2 shows an example of centipede like 18 wheeled 
mobile robot [23] known as Tamiya 70230. This algorithm helps to navigate a robot in planar of unknown 
location which is filled with static as well as dynamic obstacles of undefined but regular shape. Range sensor 
is used to recognize an alteration in distance to recognise obstacle positions. Figure 3 shows the scanning 
process of a range sensor in its field of view (FOV) to detect obstacles [21]. We believe perhaps an 
unbounded space Q € R? occupied by a set of bounded static and dynamic obstacles O = {O;,Qo, . . .,Ox}. 
The whole environment is considered to be in 2D with the objective of simulation. Further we consider a 
robot which is made up of a series of wheeled robot. The first wheeled robot rake is furnished with range 
sensor to sense obstacles. Figure 4 illustrates the head of the centipede inspired robot in rectangular shape 
with wheel and other equipment. The other rakes contain a compact, multi-core propeller microcontroller 
with hardware to communicate between each. We put the robot and the obstacle in 2D plane and assume a 
virtual circle surrounding the robot. Every part of the robot will be considered inside a virtual circle. The 
head and other rakes are same in almost all aspect but the only difference is a sensor is attached with the head 
which can scan 180° area. During movement every rake or section of the robot supposed to go after the same 
coordinates of its predecessor. The initial and final coordinate with respect to global frame of reference is 
known to robot. Prior we proceed to the description of algorithms, we compose some important and helpful 
assumption and definition for this algorithm which are almost same as [22]. 


‘ront End 


wc 
IR Virtual Circle 


Rear End 


Figure 2. Centipede like wheeled _— Figure 3. Obstacles detected by range _ Figure 4. Display of robot and 
robot with reference to [23] sensor(R) obstacles in 2D plot 


2.1.1. Assumption 

— The robot is supposed be as few physically and analytically connected small robots 

— The algorithm uses world co-ordinate system as global frame of reference 

— All position coordinates (including with initial and goal) are at first quadrant 

— The velocity and angular velocity of robot is constant in every movement and rotation respectively 

— The environment is flat and maintains equal altitude everywhere 

— The mobile robot moves in a two-dimensional space and rotates without slipping 

— Both the robot and dynamic obstacles are run in constant speed and in straight line. If anyone wants to 
change direction it has to stop then turn then again start moving 
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2.1.2. Important definitions 

The robot scans the surroundings 0° to 180° by range sensor. So to make a scan of total 360° the 
robot has to rotate the head part 90° left and right and scan the environment again. Obviously it is required if 
the centipede gets full of obstacle at 180° scan. We consider on bounded and unbounded space O and Q ina 
reading from range sensor within a time period, tn to tn+1. If it notices a variation in distance say Ad (where 
Ad value is defined) in range at any position then that position point is regarded as Open Point. The primarily 
the robot facing directly to goal point and afterward it begins scanning for open point. Sub goal point is a mid 
objective of the robot to attain the final objective. This point is placed at a particular difference from 
the corresponding open point and perhaps creates a right angle at open point to the line passing through 
the sensor point of robot and the open point. From the coordinate of open point corresponding sub goal point 
is determined. The robot selects one point called critical point, for subsequent move from a set of sub goal 
points. This point is selected on the base of smallest distance from the target point and so far not considered 
for movement. The robot attempts to move its each rake’s center of virtual circle to critical point or to virtual 
circle’s center of its predecessor. The midpoint of the two extreme points of each robot’s rake is centre of the 
corresponding virtual circle and the half distance between the two extreme points of the rake with a safety 
constant A is the radius. The lowest value of 4 can be obtained from few number of experiments. Figure 4 
shows the plotting and other required geometrical details. 
d— Perpendicular distance of obstacle from the sensor 
A-— Location of robot wheel-‘axle’ (imaginary line) center 
X-— Distance from sensor to open point 
w — Distance between wheel-‘axle’ center and wheel center 
F-— Distance between the rear end and wheel ‘axle’ center 
R-— _ Distance between the wheel ‘axle’ center and the rear end of the robot 
C-— Center of the virtual circle 
a— Open point detection angle by the sensor 
X.- Safety constant for the robot 
r—  Radious of the virtual circle 
B—- Sensor direction angle at open point with respect to the line parallel to x-axis and passing through (xi, yi) 

before movement 
@— Angle generated by B with respect to the line parallel to x-axis for sub goal point coordinates calculation 
w- Angle created on a line parallel to x axis and passing through sensor by a line from sensor to open point 
y— Angle between line joining open point & subgoal and the line parallel to x-axis and passing through 
open point 

di— Distance of a sub goal point from current location 
Xs and y; — are the sign factors used in determination of the coordinates of open points 
Sx and sy — are the sign factors used to determine the coordinates of sub goal points 


We consider, 

Tn= {(X1,Y1),(X2,V2),---.(%i, Vi) } as a set points travelled by the robot’s nth link where (x;,y;) symbolize the 
coordinate values the nth link arrived 

OP={ ((Ga,da),(Gp,dp)),.---.((x,dk),(0,d;)) } as a set of open points of obstacles identified by the sensor 
where a and d indicate the angles & distances of open points respectively from the robot and each 
((Ga,da),(b,dp)) represents two open points connected to each obstacle, if only one point is detected 
then o,=o% and d,=dp 

SG= {(ai,bj),.....,(xj,yj) } as a set of sub goal points recognized by the robot and every (ai,b;) signifies the 
sub goal point which the robot can select for next move 

Tobs= {((ai,bi),...(aj,b))),...--5((Xi, Yi),--(Xj, yj) } aS a Set of initially identified obstruction where each 
((ai,bj),.. .(aj,bj)) are the set of points of each obstacle. 

Sobs= {((ai,bj),.. .(aj,bj)),...--5((Xi,Vi)s--»(Xj,yj)) } as a set of fixed obstacles where every ((ai,bi),...(aj,b))) are 
the set of points of each fixed obstacle. 

TDovs= { ((ai,bi),...(aj,bj)),.----.((XiYi),--5(X} Yj) } as a Set of initially moving obstacles where every 
((ai,bj),...(aj,bj)) are the set of points of each provisionally moving obstacle. 

Dovs= {((ai,bj),. . .(aj,bj)),......((Xi,i),--(X%;¥j))} as a set of movable obstacles where each ((ai,bj),.. .(a),b;)) 
are the set of points of each movable obstacle. 

D= {((Xa,Ya),5a),---5((X;, ¥j),5;) } aS a Set of sub goal points and distance from target of that point where each 
set ((Xa,Va),0a) represents the set of sub goal point and their distance from target 

Here dmin is the distance from the robot to goal point and @ is the direction of the same. 
Pc is the position where the robot may collide with the obstacle and the distance from current position of 
robot to the point of collision is Dc. 
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2.1.3. Algorithm 

a. Main procedure 

1. Robot Start 

2. Take input of the position co-ordinates of source and destination 

3. Calculate the distance and direction from source to destination dmin and ¢ respectively 

4. WHILE not Destination 

5 Start OBSTACLE_DETECTION procedure in FOV 

6 IF obstacle or virtual obstacle in direction 

7 Calculate the coordinates of sub goals from OP, don’t calculate same set from OP twice and 
save it in set SG and D 


8. Calculate distance of each sub goal from destination and save it in set D 
9: Select the coordinate point P having the lowest distance in D 
10. IF the point exists in Traverse point set T; 

11. Discard the point 

12. Select the next lowest distance point P from D 

13. Follow step 10 

14. ELSE 

15. IF P is SAFE_POINT 

16. Save the coordinate in traverse point set T, 

17. Calculate angle of rotation and rotate 

18. Call MOVE Procedure to move at P 

19. IF obstacle dynamic 

20. IF VIRTUALOBSTACLE 

21. Follow step 7 

22. END IF 

23. END IF 

24. Calculate direction ¢ and distance dyin 

25. ENDIF 

26. ENDIF 

27. ELSE 

28. Calculate the next point coordinate P towards the direction 
29. IF P is SAFE_POINT 

30. Save the coordinate in T; 

31. Call MOVE Procedure to move at P 

32. Calculate new dmin 

33. END IF 

34. END IF 


35. END WHILE 
36. Robot Stop 


Move procedure 
FOR i=n to 2 
Save the last coordinate of Tj_; in traverse point set T; 
END FOR 
FOR i=1 ton 
Move the ith link toward the last point of T; 
END FOR 
Obstacle_detection procedure 

Scan 0° to 180° 
Identify obstacles in FOV 
Calculate the coordinates of open points and save those points in set Tops 
IF no open points 

Rotate the head left 90° 

Scan 0° to 180° 

Calculate the coordinates of open points and save those points in set Tops 

Rotate the head right 90° 
: Scan 0° to 180° 
10. Calculate the coordinates of open points and save those points in set Tos 
11.END IF 
12. FOR any coordinate in Tops 


$008 Ve AO MOYO ON Oe INS. 
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13. IF coordinate set of Tops exists in Sobs 


14. Discard the coordinate from Tops 

15. ELSE 

16. IF there exists any nearest point in Sop; with small change in x or y value 

17. The obstacle may be dynamic 

18. Save coordinate in TDobs 

19. ELSE 

20. IF there exists any nearest point in TDots with small change in x or y value 

21. It is part of moving obstacle 

22. Save the points of TD»; and To»; to the robot registry and all the open points of the 
obstacle — in Dots 

23. ELSE 

24. Save the points in Sos 

25. RETURN obstacle 

26. END IF 

27. END IF 

28. ENDIF 

29. END FOR 


30. IF obstacle dynamic 
31. IF VIRTUALOBSTCLE 


32. RETURN virtual obstacle 
33. END IF 
34. END IF 


d. _ Virtualobstacle procedure 


1. Calculate direction € and speed Vops of the obstacle from the points exists in robot registry 

2. IF the obstacle direction € intersecting robot direction 

3. Calculate probable position Pc of collision 

4. Calculate probable distance Dc from the robot to Pc 

5. IF De<dmin 

6. Calculate the time Rrci and Rrc2 the robot will take to arrive at Pc and cross Pc fully 
respectively 

7. Calculate the time Orc moving obstacle will requires to arrive at Pc 

8. IF Rrc2>=Orc and Rrci<=Ortc 

9. Identify the point Pc and all the adjacent points of the obstacle as __ virtual Obstacle 

10. Calculate the open points and save in OP 

11. RETURN virtual obstacle 

12. ENDIF 

13. END IF 

14. END IF 

e. Safe_point procedure 

1. IF P corresponds to a sub sub set of OP 

2 Select the sub set from OP that corresponds to P 

3. IF it is first sub set 

4. Select the second sub set from previous set from OP 

5 ELSE 

6 Select the first sub set from next set from OP 

7 END IF 

8. Calculate the distance Sd between two sub sets 

9. ELSE 

10. Select the two points from OP having minimum distance from P 

11. Calculate the distance Sd between two points 

12. ENDIF 

13. IF Sd < 2r 

14. RETURN safe 

15. ELSE 

16. RETURN not safe 

17. ENDIF 
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3. DISCUSSION AND RESULT 

The principle motive of the algorithm is to create a continuous path from fixed source to destination. 
Avoiding static obstacle can be is discussed in [20-21], the Figure 1 shows the avoidance as per [20]. Current 
algorithm attempts to avoid moving obstacle too. Also this algorithm in contrast of [21], judges the robot as a 
series of rakes having dimensions not only a point and averts collision with the obstacles using preventative 
measure. Figure 5 shows each part of the robot considering in a virtual circle avoid obstacle and the open 
points and its related sub goal points is shown in Figure 6 Calculating sob goal point using required 
methodology is reflected in Figure 7 All the sub goals situate perpendicularly reverse direction of the related 
open points. To avoid the obstacle the robot has to turn the rakes. The turning angle and displacement of 
robot’s position due to turn is shown in Figure 8. 


Sensor Point of Robot 


@ Open Point 
@ Sub goal Point 


Figure 5. Whole robot inside the virtual circle with Figure 6. Obstacles’ open point and sub goal point 
safety measurement A detected by robot 


3.1. Algorithm study and analysis 
Let an open point is identified by sensor at angle a. As per [20] 
~ Bi= (0 +Bi1)%360 


Xi+1, = X+dcos0(xs) t (1) 

Yi+1 j= ytdsinO(ys) (2) 

Here (x,y) is the location of sensor and (Xi+1,,¥i+1,;) is the location of jth identified, one of subsequent 
open points at (i+1)th iteration and in accordance to worlds coordinate system. The open point appears in two 
ways. |. If earlier value of a, the sensor angle a -1 senses an obstruction and 2. Subsequent value of a, the 
sensor angle +1 senses obstruction. Each of these two also have two sub cases and those are: a) y > 90° and 
b) y <= 90° 


where y = B%180° 
So we can describe y as follows, 


yw-90°,Sx= 1,Sy=1 ify>90° & a—1 not obstacle 
w—90°,Sx = —-1,Sy=—-1 if y>90°& a—1 is obstacle 


Y=) 90°-y,Sx=1,Sy=-1 ify < 90° &a — 1 not obstacle (3) 
90°—y,Sx=—-1,Sy=1_ if y< 90°& a — 1is obstacle 
If (Xi+1j,Yi+1j) 18 open point P then as per Figure 7, coordinate value of connected sub goal point Q is: 
Qx = Px + Sx. aes 4 
Qy = Py + Sy.rcosy o 


(Qx,Qy) will be the next centre after move of the virtual circle that contains the head part of 
centipede inspired robot. In accordance to Figure 4, A is the wheel axel centre and AC is the distance among 
the virtual circle centre and wheel axel centre. So, the value of next position of wheel axel centre A can be 
determined as, 
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Ax = Qx + Sx.ACcosy 5 
Ay = Qy+ peared (6) 

Now the head part of robot will compute the required angle of rotate to move wheel axel centre and 
then start progressing to next position. The remaining part of the robot will follow it predecessor links 
coordinate location for next move as written in algorithm. During its turning to avoid obstacles the robot gets 
displaced from its dmin line, which it has to cover in near future. Maximum it turns the maximum it takes to 
cover. According Figure 8, if Y is the displacement value then, 


Y=(F+R)sinQ (6) 
Q= sin"1Y/(F + R) (7) 


Here (F+R) is the length of each rake and Q is the maximum permissible rotation angle of a rake. 

Irrespective of mobility or non-mobility every obstacle is stationary at an exact point of time. If the 
position changes of an obstacle then it is moving otherwise it is static. For moving obstacle the possible 
position in future can be determined from its speed and direction. Figure 9 illustrates how to avoid dynamic 
obstacle using MCSB algorithm by predicting the virtual obstacle location. The stated scheme allows the 
robot to avoid securely static obstacles shown in Figure 10. For mobile obstacles is has find out the speed of 
that obstacle by sensing its position at two separate time ty; and ty where At=t,,)-tn. Therefore, 


Figure 7. Open point to Sub goal point calculation Figure 8. Turning angle and displacement during turn 


@ Destination 
A Obstacle stacle 
Hl atts atte-1 
! Obstacle 
' att] . - 


{Virtual Obstacle > 
atts] -- 


Identified 


5 ° SH ~ 
Virtual | & _cig -/Head of robot 
Obstacle, wae pe reachattg+2 
atte --ir Te 


y 
aor @ Head of robot 

ne reachattg+1 
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‘ail of robot at ta+1 moctedpem 


2 
s Source 


Figure 9. Avoiding a moving obstacle by calculating Figure 10. Avoiding obstacle in Local Minima 
virtual obstacle twice 
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Vobs = (On1-O1) (9) 


At 


where O;+1,0; are Obstacle positions at time instant tn+; and ty and Vobs is speed of the mobile obstacle. By 
solving equation of robot’s direction and obstacle’s direction the probable position of collision (Pc) can be 
calculated. The next task is to find out whether there will be a real collision or not at Pc. If there will be a 
collision then the position and its surrounding will be identified as virtual circle. If Pa(rXn+1,ryn+1) be current 
location of the robot at t,.,. Then, 


Dc = V (CX — rxni1)? + (Cy — rynti)? (10) 


where (Cx,Cy) is the coordinate position of Pc. By the value of Dc robot then determines, 


Rrei = Def, (11) 
Ree Cet Rey. (12) 
Orc = Defy. (13) 


The velocity of robot is v. Rrci and Rrcz are time of entering at Pc and exiting from Pc respectively 
and Orc is the time the obstacle will take to arrive at collision point. N is number of links or rakes of the 
robot and r is the radius of virtual circle. Orc lies time range Rrc; and Rrc2 means they will be at Pc in the 
same time period in near future. So the point will be indicated as virtual obstacle and distorted trajectory will 
be shaped with safety measure. How the robot will avoid local minima problem is illustrated in Figure 9. If 
the robot fails to find an open point in direction FOV the head will rotate right and left as much as possible, 
scan the area take open points. If it still fails then it has to rotate the whole robot. The Figure 11 shows how 
to avoid an obstacle with safety measurement. Here in this figure it is described for a single link. But for any 
links it is applicable as all the links follow the same path to reach destination. 


© Destination 


Not Safe 


Figure 11. Obstacle avoidance with safety measurement 


3.2. Total time and path length calculation 
If vj and w; are the speed and angular velocity at ith iteration then, time taken in moving 
and rotating [20]: 


Ty = Lito 4i/V; 
Tr = iio G/Q; 


So the cost function in terms of time for one links is: 
n m 


c= Yalu + a;/W;) +) Dor 
i=0 j=0 
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where DOT is the time taken to identify mobile obstacle and its direction of progress and speed. 
So the total cost in terms of time for all the links or the whole robot is: 


TC=) G, 


1 


3.3. Simulation results 

How a robot is using ModifiedCritical-Snakebug algorithm to stay away from stationary and non- 
stationary obstacle shown in the Figure 12. There are twelve separate snap shots of twelve separate moments 
in same environment. The gray coloured, rectangular shaped object is non-stationary obstacle and static 
obstacles are of green rectangular. The algorithm is modelled using Python 3.5 on windows 7 platform. Intel 
core 13-2350@2.30 Ghz Laptop with 2 GB RAM is used. The red circle at the top and foot are the goal and 
initial points respectively. The path robot travelled is shown using Black line. 


Figure 12. Snapshots of trajectory generated using modifiedcritical-snakebug algorithm on 2D plane 


4. CONCLUSIONS AND FUTURE WORK 

The earlier works is further continued in this paper. The foremost intention is to build a local path 
planning algorithm on simple sensor based for bio-inspired centipede like multi rake robot. The algorithm 
makes an effort to think about the restrictions of robot’s dimension. To complete the task using this bug 
algorithm the robot requires very little prior information. Measuring the safety precaution makes the 
algorithm more effective. This algorithm helps to avoid a very small the gap or to pass through small gap 
which is big enough to pass. In case less complex environment or environment with few numbers of obstacle, 
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the algorithm and other algorithm doing the same task may take approximately same time. Few favorable 
points of this algorithm are: (a) It never judges the all the obstacles for avoidance. (b) Uses well-organized 
technique to estimate coordinates of different points. (c) It is an algorithm for multi rake robot to avoid any 
obstacles of regular shape. (d) Tries to take as possible as less time to reach at destination. The algorithm will 
be used to test real multi rake robot in the future,. Further it will be studied using camera vision for snake like 
robot and for multiple robots path planning in one environment. 
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